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ABSTRACT 



This thesis details the design of the Naval Postgraduate School’s Flexible Spacecraft Simulator 
and the first attempts at simulation and control of the model. The effect of flexible structures on the 
attitude control of spacecraft has been a topic of research for many years. Only recently has the 
technology to actually test models and theory on the ground been available. At the Naval 
Postgraduate School, an experimental testbed for research into this area has been constructed. This 
facility consists of a satellite model with a flexible arm floating on air pads to eliminate the effects 
of friction. The Flexible Spacecraft Simulator will become fully operational in July, 1991. A 
mathematical model of the system has been constructed and simulations of various maneuvers have 
been run, utilizing proportional-derivative (PD) control as well as a Linear-Quadratic-Gaussian (LQG) 
compensator. Results show that both PD and LQG work well for station keeping, but that the LQG 
compensator is better for slewing the arm. 
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I. INTRODUCTION 



A. REASON FOR ANALYSIS 

The control of flexible spacecraft structures has been a topic for research for 
several years. Every since Explorer I began it’s now famous tumble, dynamicists have 
been concerned with the effect flexible structures have on spacecraft attitude and control. 
In the early days of the space program, most satellites and vehicles consisted of rigid 
bodies with very small, flexible appendages. The effects of these appendages were 
considered mostly in terms of energy dissipation and in turn the effect on attitude 
stability. Current spacecraft have much higher power requirements than in the past, thus 
requiring larger solar arrays. Dish antennas with substantial support structures are being 
utilized. Lighter structural materials are being employed to save launch costs. Higher 
pointing accuracies are now required. All of these factors contribute to a wider control 
bandwidth and a lower structural frequency resulting in the possibility of control/structure 
interactions. These interactions must be known and controlled in order to meet the 
demands of the next generation of spacecraft. 

In order to determine the effect of flexibility on the control of spacecraft, 
experiments in the design and location of sensors and actuators as well as the control 
laws should be conducted. Conducting experiments in space is prohibitively expensive. 
Simulations on computers are very important and useful, but nonetheless cannot be 
proven accurate until actually implemented. Conducting experiments on the ground in 
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a gravity-free environment is impossible. However, by proper design, two-dimensional 
experiments may be conducted in a frictionless environment. 

B. SCOPE OF THESIS 

This thesis covers the design of the Naval Postgraduate School’s Flexible 
Spacecraft Simulator or FSS. This experimental testbed was designed for the analysis, 
simulation and implementation of different control systems for flexible spacecraft. The 
FSS is a two-dimensional model of a spacecraft with a deployed, flexible, support 
structure for an antenna. The initial basic design and choice of actuator/ sensors was 
presented in Ward [Ref. 1]. This thesis details the integration of the actuator and 
sensors as well as the construction of the model. The equations of motion for the model 
are derived, as well as the state-space form for digital implementation. Finally, the first 
attempts at simulating the motion and control of the model are presented. 
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n. EXPERIMENTAL SETUP 



The configuration of the experimental setup for the Flexible Spacecraft Simulator, 
(FSS), is shown in Figure 1. 




A. SATELLITE MODEL 

The satellite model consists of an ’L’ shaped flexible appendage attached to a 
circular rigid body as shown in Figure 2. For this phase of the experiment, the reflector 
and feed horn are not used. The rigid body, denoted the "central body", is a 2.22 cm 
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(7/8 inch) thick aluminum disk of 0.381 m (15 inch) radius. The central body is 
supported by three aluminum air pads and restricted from translational motion by an air 
bearing. The air pads are spaced equally about the circumference of the disk and are 
inset into the central body to minimize the height of the system above the table. The air 
bearing is connected to the central body by means of a thin, 0.127 mm (0.005 inch), 
flexible sheet of metal. This reduces the effect of any torque about the X or Y axis upon 
the air bearing, which has very little tilt stiffness. The top of the air bearing is 
connected to an I-beam with an adjustable bracket. The bracket and associated movable 
supports allow positioning of the model anywhere on the table’s surface. A cross sect- 
ional view of the air support system is shown in the following figures. 
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The flexible appendage, denoted the "arm", is two 2.54 cm (1.0 inch) wide strips 
of aluminum, 1.58 mm (1/16 inch) thick, joined at the elbow by a bracket, which also 
supports an air pad. The end point is also a bracket for an air pad. The "upper arm" 
is connected to the central body by means of a clamped bracket. "Mass intensifiers", 
[Ref. 2], each with 0.467 kg (1.03 lb) of mass, are utilized to lower the fundamen- 
tal structural frequency of the arm to about 0. 13 Hz. The mass intensifiers are connected 
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to the arm at a single point, (see Figure 2). This increases the mass of the arm without 
significantly stiffening the arm. With this setup, large structures with low fundamental 
frequencies can be simulated using assemblies of much smaller physical dimensions. The 
upper arm has six mass intensifiers, and the "lower arm" has two at the end. One 0.467 
kg (1.03 lb) weight was added to the "elbow" bracket and two weights to the end bracket 
in order to prevent chatter in the air pads. This combination of weights yields the 
desired fundamental frequency. 6.35 mm (1/4 inch) air line tubing, 130 PSIG test, is 
connected to each air pad and to the air bearing from the air supply system. Appendix 
A contains information concerning the mass, dimensions and inertia properties of the 
satellite model. 

B. SENSORS 

Four types of sensors are employed on the satellite model: 

1. A rotary variable differential transformer, (RVDT), is connected to the rotor of 
the air bearing by a bellows-type device. The RVDT senses the angular position of 
the central body. 

2. An angular rate sensor, (ARS), is mounted on the central body and is used to 
determine the angular speed of the central body. 

3. An integral analog tachometer is used by the DC servo motor to report momentum 
wheel speed. 

4. Two accelerometers are connected to the endpoint of the lower arm and sense 
accelerations at the endpoint. 

The manufacturers specifications are given in Appendix B. 
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C. ACTUATOR 



The actuator for the FSS, in this phase of the experiment, is a DC servo motor 
with a 10.7 kg (23.5 lb) steel disc connected to the shaft. The motor and disc assembly 
act as a momentum wheel for the satellite model. The entire assembly is housed in a 
separate aluminum structure which is then attached to the central body. Figure 6 shows 
the momentum wheel assembly with some of the panels removed for clarity. The DC 
servo motor is manufactured by PMI and the specifications are given in Appendix B. 




The motor housing includes a bottom plate which is connected to the central body, a 
thermal plate to which the motor is mounted, and side panels which support the thermal 
plate. The size of the thermal plate is dictated by the heat output of the motor during 
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worst case conditions. The steel wheel is covered by an aluminum safety housing to 
prevent injury during operation, 

D. CONTROLLER 

The control system consists of a VAXStation 3100 model 30, (networked to a 
mainframe VAX), the AC-100 controller, and the associated software for the AC-100. 
The VAXStation is a 2.8 MIPS (million instructions per second) workstation configured 
with eight Mbytes of main memory, a 19 inch color monitor, two 104 Mbyte winchester 
hard disks, and a mouse. The development software, which includes MATRIXx, 
Autocode, Interactive Animation, RTMONIT Real-Time Monitor, a ’C’ Compiler and 
the Linker/Loader, is used to create the model of the FSS and executes on the 
VAXStation under the VMS operating system. The AC- 100 Controller provides the 
real-time testbed execution environment. It consists of the following standard hardware 
components and their associated drivers: 

1. An 80386 based MULTIBUS II Application Processor. 

2. An 80387 Coprocessor. 

3. A Weitek 3167 Coprocessor. 

4. An 80186 based MULTIBUS II Input/Output Communications Processor. 

5. A/D, D/A and Digital Data Translation DT2402 I/O Board. 

6. Two INX-04 Encoder and D/A Servo Boards. 

7. An External Trigger Board for the first application processor. 
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For details of the operating system see the AC-100 Users Guide, [Ref. 3]. The 
simplified electrical schematic for the sensors, actuator and controller is shown in 
Figure 7. The controller, servo-amplifier, power supply and transformer are housed in 
a 19 inch rack. 
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m. THEORETICAL ANALYSIS 



A, EQUATIONS OF MOTION 

In order to control the satellite model efficiently, the dynamics of the system must 
be thoroughly understood. The first step is to determine the equations of motion of the 
model. The hybrid-coordinate system of Ref. 4 is utilized in this study. The 
hybrid-coordinate system separates the model into two distinct subsystems which may be 
classified as either a flexible appendage or a rigid body. The flexible appendage is 
assumed to be a linearly elastic structure for which "small" deformations may be 
anticipated such that elastic stresses remain proportional to deformations. The flexible 
body is further broken up into small rigid "subbodies". In this case, the flexible 
appendage is the "arm" and the rigid body is the "central body". Each subbody 
corresponds to a mass intensifier or an air pad bracket on the flexible arm. Lagrange’s 
equation together with the hybrid-coordinate system are used to derive the equations of 
motion of the model. Figure 8 depicts the coordinate system. 

Three coordinate axis are used in the derivation. A fixed, ("inertial"), coordinate 
system is located at the center of rotation of the system, (constrained by the airbearing 
to be the center of the rigid body). The origin of the second coordinate system is also 
located at the center of rotation, rotates with the body, and is the body coordinate 
system. The third coordinate system is located at the center of mass, (CM) of the system 
and is the CM coordinate system. The CM and body coordinate axis are parallel to one 
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another. Subscript A corresponds to the flexible appendage, C to the rigid body. 
Subscript W corresponds to the momentum wheel system and subscript S denotes a 
subbody on the arm. The other symbols used in the derivation are as follows; 



V - VELOCITY VECTOR OF AN INFINITISIMAL MASS 

V - VELOCITY OF CM OF SYSTEM 
r - POSITION VECTOR 

Mj. - TOTAL MASS 

M - MASS 

(3 - ANGULAR VELOCITY VECTOR OF SYSTEM 

P - POSITION VECTOR OF UNDEFORMED SUBBODY 
a - POSITION FROM UNDEFORMED TO DEFORMED SUBBODY 
0^ - ANGULAR POSITION OF MOMENTUM WHEEL 

Tj; - ROTATION ABOUT Z (FIXED COORDINATE SYSTEM) 

I - INERTIA 

4> - MODAL COORDINATE 
q - MODAL AMPLITUDE 
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m - NUMBER OF MODES 
n - NUMBER OF SUBBODIES 
i - MODE 
j - f SUBBODY 
to. - FREQUENCY OF i** MODE 
C - DAMPING 

T - KINETIC ENERGY OF SYSTEM 
V - POTENTIAL ENERGY OF SYSTEM 
L - LAGRANGIAN 

In order to form the Lagrangian, the potential and kinetic energy of the system 
must be known. The kinetic energy is found as follows: 

= lMj[c5xr(cm)P + 

where is the velocity of a particle on body C with respect to the CM coordinates and 
is the velocity of a particle on body A with respect to the CM coordinates. The 
position of the center of mass from the fixed coordinate system is denoted r(cm), and TV 
is the kinetic energy of the system due to the momentum wheel. Vq will be due only to 
the rotation of the central body: 



Vc = r = toxf^ 



( 2 ) 



The over-dot denotes differentiation of the vector with respect to time. 
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will have both rotational and translational terms. If the assumption is made 



that: 
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Vj may be expanded as follows: 



(3) 



s - - - (4) 

Vj = Pj + Uj = SfxPj + Uj + c3xi^. 

Expanding the dot product of Vj with itself for each subbody, yields: 



V/Vj = + Vj'Uj + K/((3x«p 



(5) 



Vj'V. = (c3xPy)*(c3xPy) + {(^xPj)'U + (c3x^.)*((3xu ) 

+ S*(SxPp + u'u + u'(Qxup + (Cxi^.)'((3xPp 
+ (cSxMp'M + (c 5 x«P*(( 3 xm^.) 

= |OxPyp + 2[(u'(u>xPj)) + (u>xPj)'(u>xUj) + M*(wxi7p] 
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Finally, expanding the kinetic energy term due to the momentum wheel: 



= I M^[((3 xr(W ) ) -(w xr(W ) )] + ^1^0% (7) 

where r(W) is the vector from the origin of the fixed coordinate system to the center of 
the momentum wheel. 

Utilizing the constraints of the experimental setup and the superscripts x, y and z 
to denote components of a vector along the CM coordinate axis, the vector equations are 
replaced by the following: 

w = tiG 

axP. = (-Y/>/)f + (tP/)/ 

CdxUj = + (^Uj)j 

V.'Vj = + {P]f\ + - 2TP/ - 2ti//) (8) 

+ + 2tP/ + 2Tu/) 

+ u/[t"(2P; + u/)] 

^ u][^\2P] + u/)] 

Noting that the components of the deflection vector, u , may be written as below: 

i=l i=l 

the kinetic energy of the system may now be written in terms of the modal coordinates 
and amplitudes, and the systems angular velocity: 



14 



( 10 ) 



/ ^ 7=1 






* I'X 



* tE r - iffiiPj) * (<)"«.' 

-^7=1 i=l 

+ 2t\4>^7>/ + <i)J^7»/) + T"[(<j)J)2^f + (4)J)'^?]} 



The first term in the brackets is the inertia of the system about the Z axis (fixed 
coordinate system), minus the terms due to the momentum wheel itself, or: 



I’zz = M,|r(cn.)|" - ( MdM * Y.>^j\P,\^ 

^ ;=i 



( 11 ) 



The potential energy is now calculated using standard matrix notation: 



V = ^[uV[k\[u\ [u\ = [4)][g] 



( 12 ) 



where [k] is the stiffness matrix. If [4>] is normalized such that the mass matrix is unity, 
then 



[•!)]'■ M [<!)] 




(13) 



where the term on the right is the diagonal matrix of natural frequencies for each mode. 
This results in: 
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V = 






(l); 



[4] 



( 14 ) 



lA 2 2 
■^ 1=1 



Now that the potential and kinetic energy of the system have been determined, the 
Lagrangian, L = T - V, may be formed. Lagrange’s equation is written: 



£ 

dt 



dL 






dL 

d\x, 



= Qi 



( 15 ) 



with each generalized coordinate represented by /tj and the generalized forces by Q. The 
generalized coordinates for this system are 0^, and each of the qj’s. The virtual 
work principle may be utilized to determine the Qi’s. Taking N to be the total number 
of generalized coordinates: 



N 



6w = 5^(2, -6p, = T6T - T60^ 



i=l 



= -T 



<?T =T 



( 16 ) 



where T is the torque applied by the motor. Lagrange’s equation for each of the 
generalized coordinates can now be written as follows: 




( 17 ) 
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4 ’’ + * ( 4 ';*? * 24 ' 5 >/ 4 , * (Vufi^) * M„\nw)\ 



Y 



/=i i=i 



* m,[4.’/; - 4.'//]4", 

M, [2+'/; t 2(4.')^,, * 24.jp/ t 2(4.J)*«,] 4-4,) = T 



( 18 ) 



EK[(4-'/ • Cl>5)1«. - K((4-y - (-t-'/) - “?1«. 

- * 4>JfJ?’]4'" <■ M^[4/// - 4>*P/]t) = 0 



( 19 ) 



Equation (19) above is repeated for each of the m modes. Assuming that the body slew 
rate is small, the nonlinear terms will tend toward zero. Dropping the nonlinear terms 
and introducing a damping term for each mode yields the following linearized equations 
of motion: 



& * Eo,4, = T = 

i=l 

E^q^ + + D.Y = 0 



where: 



n 



D, - T,W; - 4 .' p?k 

;=i 

E, ‘ E[(-I>J)" * (-l-Jl^H 



(20) 



Again, the last equation is repeated for each of the m modes, resulting in m + 1 
equations to be solved in order to determine the motion of the model. The D, term is 
designated the flexible coupling term and JE',- is the modal mass term. If the modal 



17 



coordinates, are normalized such that the mass matrix is unity, then £, will also be 
unity. This fact is used to check the results of the finite element analysis of the arm. 
The damping term f must be assumed or experimentally determined. 

In order to implement the equations on a digital computer, a state-space 
representation of the system of equations is constructed. The state-space format is: 



where X is the vector of state variables, Y is the output vector, and U is the vector of 
inputs. The matrices A, B, C and D complete the description of the system of equations 
in state-space form. For the FSS, the state variables are chosen to be: 



X = [A]X + [B]U 
Y = [C]X + [D]U 



( 21 ) 



X = [T, q^, ..., q^, Y, q^, q^, ..., q^f 



( 22 ) 



The output vector Y, is defined by the sensors installed on the model: 



r = [Y, t Y 



( 23 ) 



The input vector U is the torque applied by the motor: 



U = T 



( 24 ) 
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Rearranging the equations of motion to explicitly solve for the second derivative with 
respect to time of the state variables, in terms of the state variables and the input torque 
T: 



Y = 



T * * O,(0>,)V,] 

i=l 

i=l 






( 25 ) 



- D. 



E W2Co>,q, - (co,)^^,)] - T 

i = l 



m 



li - 

i=l 



Note that if a rigid body were assumed, all of the qj’s and 4’s would be zero and Euler’s 
equation would result: 



Y 




( 26 ) 
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The state-space representation can now be written as follows: 



T 

92 

t 

9 1 

92 






.o 2 

'ZZ 



0 


0 


0 


0 


0 
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( 27 ) 






jo2 



0 

0 

0 

0 

0 

1 

-D. 



(T) 



where: 

i=l 

G, H, 

J, - Ha fa * Df, 



i^zz ^ ~ 

<2 



( 28 ) 
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The observation equation is written below: 



Y 




1 


0 


0 . 


. 0 


0 


0 


0 . 


.. 0 


Y 




0 


0 


0 . 


. 0 


1 


0 


0 . 


0 



T 

^2 

Y 

^2 



^ [0](T) 



(29) 



B. FINITE ELEMENT MODEL OF APPENDAGE 

In order to utilize the state-space equations written above, the mode shapes and 
associated frequencies must be determined. For simple geometries, the required modal 
coordinates and natural frequencies may be solved for by analytical means. However, 
for complex geometries such as the FSS, a finite element analysis is required. The 
interactive finite element program GIFTS was utilized to model the arm. 

The appendage was modeled using beam elements with the same cross-section as 
the model’s arm, and point masses at the location of the mass intensifiers. Point masses 
were also placed at the elbow and tip to simulate the air pad brackets, air pads and 
associated masses. The appendage was divided into 20 nodes, each corresponding to a 
subbody in the hybrid-coordinate system. All degrees of freedom were suppressed at 
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node one, (the central body attachment point), resulting in a fixed-free analysis. The 
rotations about the X and Y axis were also suppressed for all the nodes, in order to more 
closely approximate the constraints imposed by the two dimensional model. The modal 
analysis program was run resulting in the desired modal coordinates, normalized for a 
unity mass matrix, and the associated natural frequencies. The first six mode shapes are 
shown below. 
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Figure 9 Mode Shape One 
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Figure 10 Mode Shape Two 




Figure 11 Mode Shape Three 
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Figure 12 Mode Shape Four 




Figure 13 Mode Shape Five 
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Figure 14 Mode Shape Six 



The output of the GIFTS program is given in Appendix C. Also given is a Fortran 
program that inputs the GIFTS result and outputs the A and B matrices of the state-space 
system described previously, in a form required by MATRIXx for use in modeling the 
system. 

As a check on the GIFTS output, an experiment was conducted on the model to 
determine the fixed-free natural frequencies of the arm. The model was floated on the 
air pads and the central body restrained from rotation. The arm was deflected into the 
first mode shape and released. The accelerations at the endpoint were measured using 
the PCB accelerometer, (described in Appendix B), and a HP-3561A Dynamic Signal 
Analyzer. The accelerometer was mounted perpendicular to the lower arm. Table I 
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shows the results. Figure 15 and Figure 16 show the actual output of the analyzer. The 
first two frequencies agree very well with the GIFTS data. Any frequencies above mode 
two had too low of an amplitude to be measured accurately and could not be verified. 
Even initially deflecting the arm into these mode shapes resulted in very low amplitude 
oscillations, not measurable by the installed equipment. 



TABLE I Comparison of GIFTS Data with Experimental Results 



Mode 


Experimental 


GIFTS 


Difference 


one 


0.13 Hz 


0.122 Hz 


-6% 


two 


0.39 Hz 


0.346 Hz 


-11.3% 
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Figure 15 First Modal Frequency 




Figure 16 Second Modal Frequency 
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rV. DYNAMIC SIMULATION 



A. MATHEMATICAL MODEL 

As a step in understanding the FSS and in attempting to control it, a mathematical 
model was constructed. The mathematical model can also be used as an observer in the 
control system, since only two of the state variables may be fed back. In constructing 
this model, the number of modes, m, must be truncated to some reasonable number. 
Modal truncation is a matter of importance and demands some study. However, since 
there are no sensors or actuators on the arm that are to be used in the present control 
system, a simple algorithm was used. As a minimum, include those modes that are 
observed in the motion of the arm, but do not include so many modes that the resulting 
matrices will be computationally difficult and time consuming to solve. As a result, the 
first six modes were used in the simulation. In deflecting the arm and observing the 
resulting motion, the first two modes appeared to be prevalent, with very little high 
frequency motion. Six modes result in a 14 by 14 dynamics matrix which may be 
readily solved. The first six modes also cover a factor of 100 increase in the natural 
frequencies. 

The state-space system is generated by the Fortran program Form , (Appendix C), 
assuming that structural damping of the aluminum beam is two per cent of critical. The 
system of matrices is implemented on the VAX workstation. In order to use the 
simulation to run the real time controller, the ’plant’ must be discretized. A 0.01 sec 
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sampling interval was chosen for the discretization, giving approximately ten samples per 
period of mode six, the highest frequency mode shape simulated. A one N-m torque of 
0. 1 second duration was simulated to observe the effects of the flexible appendage. This 
impulse was also simulated on a rigid body with the same mass and inertia properties. 
The resulting position and rates are plotted in Figure 17. 
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Figure 17 Rigid vs. Flexible Model 

These results clearly show the impact of flexibility on attitude control. The rigid body 
has a smooth transition to rotation about its center of mass whereas the flexible model 
begins to oscillate, damping out after several hundred seconds. The large variation in 
body rates for the flexible model is due to the springing action of the arm, as can be seen 
in Figure 18. 
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Figure 18 Arm Motion Following Impulse 

In the figure above, the position of the arm with respect to the main body is plotted on 
the X and Y axis. The Z axis represents time in seconds. The arm’s position is 
presented every two seconds. This format will be used to show the motion of the arm 
during a maneuver. 

The next step is to determine the control laws for the flexible model. Each type 
of control will be subjected to a one N-m impulse, a five degree bias maneuver, and a 
30 degree counter-clockwise slew maneuver to determine viability. 



B. PROPORTIONAI^DERIVATIVE CONTROL 

Proportional-derivative (PD) control is obtained by simply feeding back the body 
position, Sk, and the body rate, ’F, through a gain block. Three control system 
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frequencies were chosen: = 0.05, 0.1 and 0.38 Hz. The first frequency was chosen 

to minimize control-structural interactions. The second and third were chosen to analyze 
the effect of a control system operating at the first and second mode’s frequencies. 
Damping, f , was chosen as 0.707 of critical. One simulation was run with f at critical 
damping. The gains, K and t in the control law 

= -A'(x0 + 0) (30) 

are calculated by the equations, (see Ref. 5): 



K 




, 'T 



2C/zz 

K 



(31) 



The values for K and r are given in the table below. 
TABLE n 



Designation 


o)(.,Hz 




K 


r 


PDIA 


0.05 


0.707 


0.98 


4.48 


1 PDIB 


0.05 


1.00 


0.98 


6.35 


PD2 


0.10 


0.707 


3.91 


2.25 


PD3 


0.38 


0.707 


56.44 


0.59 



The impulse response, bias and slew maneuvers for PDIA are shown in the 
following graphs, (Figure 19, Figure 20 and Figure 21). In the graphs, the momentum 
wheel speed in RPM, wheel torque in N-m, body position in degrees, and body rate in 
degrees per second, (dps), are plotted versus time in seconds. PD IB shows little 



31 



difference from PDIA except in the slew maneuver. PDIB takes about twice as long to 
reach 30 degrees as PDIA, with very little overshoot, as can be seen in Figure 22. 
Figure 23 shows the modal amplitudes for modes one and two, (ql and q2), for the 0.05 
Hz system. Modes three through six can just be seen between zero and ten seconds into 
the slew maneuver. Figure 24 shows the motion of the arm during the first 25 seconds 
of the slew, while Figure 25 is a "top" view of the motion which shows the extent of 
movement of the arm. Figure 24 and Figure 25 is obtained by multiplying the modal 
amplitudes as a function of time by the modal coordinates for each node, summing over 
all the modes and adding this value to the position of the undeformed node with respect 
to the center of rotation. 
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Figure 19 Impulse Response, PDIA 




Figure 20 Bias Maneuver, PDIA 
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Figure 22 Slew Maneuver, PDIB 
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Figure 23 Slew Maneuver, PDIA 
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PD2 show a quicker time response to the maneuvers as expected, (see Appendix 
E). However, as can be seen in Figure 26, the amplitude of mode one has increased 
about 50% and mode two has increased 100% during the slew maneuver. Modes three 
and four are also beginning to show in this figure. 




Figure 26 Slew Maneuver, PD2 

PD3 has an even quicker time response and very acceptable control of the main body, 
(Appendix E). Figure 27 presents the 30 degree slew for PD3. The main body reaches 
the 30 degree position with no overshoot in about two seconds. The 20 N-m wheel 
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torque required is within the capabilities of the motor. Figure 28 shows that the modal 
amplitudes, (modes one and two), have increased by a factor of three over the amplitudes 
in PDl, resulting in the highly undesirable whip-like motion of the arm shown in 
Figure 29 and Figure 30. Note that the torque on the body from the oscillations of the 
arm is controllable by the momentum wheel, even at these amplitudes. 
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Figure 28 Slew Maneuver, PD3 
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C. LINEAR-QUADRATIC-GAUSSIAN COMPENSATOR 



The second type of control system studied was the linear-quadratic-gaussian or 
LQG compensator. The LQG compensator is formed from a linear regulator and a 
Kalman filter estimator. The regulator design assumes full-state feedback, and a 
controllable system. The controllability grammian, [Ref. 6], for the system of 
matrices is computed using MATRIXx and is found to be of full rank, ensuring controlla- 
bility, assuming the system to be dynamically stable and time-invariant. The optimal 
gains are calculated by minimizing the cost function: 



where R„ is the state weighting matrix and R„u is the input weighting matrix. The gains 
are determined by first solving for M in the algebraic Ricatti equation, [Ref. 6]: 



where A and B are the system dynamic and control input matrices respectively. The 
optimum gain is now given by: 



These functions are computed by the command REGULATOR, in the MATRIXx Control 
Design Module, [Ref. 7]. 

The Kalman filter design is performed in much the same way, utilizing the duality 
theorem for estimators and regulators. However, instead of state and input weighting 




(32) 



0 = MA + A'M - MBR'^B'M + R^ 



(33) 



G = R^B'M 



(34) 
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matrices, R„ and Ry,, the state and observation noise intensities, Q„ and Qyy, must be 
determined. For a linear time-invariant system. 



X = Ax + Bu + Fw 
y = Cx + Du + V 



(35) 



where tv is the input disturbance, F is the input disturbance matrix, and v is the 
measurement noise, the noise intensity matrices are defined, [Ref. 7]: 



E(v(t)v'(x)) = Q^6(t-x) 
E(Fwit)v'ix)) = <?„6(f-T) 



where E is the expectation operator and 5 is the delta function. The noises, w and v, are 
assumed to be white with zero mean. For the FSS, the assumption is made that the only 
disturbance is a random torque of 0.01 N-m amplitude and thus: 

= B(0.0l)B' (37) 

Qyy is assumed to be a two by two diagonal matrix with the first term on the diagonal 
corresponding to the noise from the RVDT and the second term corresponding to the 
noise from the angular rate sensor. The best available estimate of noise is used until 
such time that the experimental value can be used. Thus: 



<? = 
VCyy 



2E-6 0 

0 6E-6 



(38) 



The Ricatti equation is solved again and the gains computed as before, however the gain 
matrix will now be a 14 by two since there will be two inputs into the estimator, (the two 
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outputs of the system). The estimator gains are computed in MATRIXx with the 
command ESTIMATOR in the Control Design Module. 

The compensator is now synthesized using the A, B, C and D matrices of the 
system and the regulator and estimator gains, Kr and Ke respectively. The form of the 
compensator is as follows: 

\A - Ke*C - (B - Ke*D) \KeJ 
SC = (39) 

Kr I 0 . 

where SC is the compensator system matrix. The LQGCOMP command in the Control 
Design Module of MATRIXx accomplishes this formation. The block diagram for the 
control system, as well as the points at which inputs and outputs are taken, is given in 
Figure 31. 




Figure 31 Block Diagram of Control System 
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All that remains is to determine R„ and R„„. R„ is a 14 by 14 matrix and is 
assumed to be diagonal, with each term on the diagonal corresponding to a state. R„„ 
is simply a scaler, since there is only one input. Positioning the main body is the 
primary concern of this thesis and therefore the first term on the diagonal, which 
corresponds to body position ’I', is set to one, and all others are set to zero. R„„ is 
assigned 0.001 in order to prevent exceeding the design limits of the motor. The systems 
response to the impulse disturbance and bias maneuvers are given in Appendix E. These 
figures show an acceptable response for the body with a 0.23 degree error during the 
impulse and three seconds required for the bias maneuver. The arm shows little 
deflection during the impulse and acceptable oscillations during the bias maneuver. 
Figure 32 shows the response to a 30 degree slew. The body reaches the desired 
position in about three seconds and the motor torque is well within limits. Examination 
of Figure 33 reveals that modes one and two are highly excited during the slew, and 
modes three and four moderately excited. The resulting extreme motion of the 
appendage is shown in Figure 34 and Figure 35 . This motion would more than likely 
result in permanent deformation of the beam. 
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Figure 32 Slew Maneuver, Cl 
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Figure 33 Slew Maneuver, Cl 
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A second means of control is required for large angle maneuvers. The modal 
amplitude graph indicates that by controlling ql and q2, acceptable results could be 
achieved. An attempt to do this is made by varying the weights on the ql, ql, 

q2, and q2, as well as the weight on the torque input. TABLE III indicates values used 
for the significant results. The figures for C2 through C7 are given in Appendix E. 



TABLE HI Weighting Factors 





Rxx 


Ruu 


Designation 


1 


ql 


q2 




ql 


q2 


T 


Cl 


1 


0 


0 


0 


0 


0 


.001 


C2 


1 


10 


10 


0 


0 


0 


0.1 


C3 


1 


ICf 


10“ 


0 


0 


0 


0.1 


C3 


1 


0 


0 


0 


• 


t 


0.1 


C5 


1 


0 


0 


0 


10“ 


10" 


0.1 


C6 


1 


0 


0 


1 


0 


0 


0.1 


Cl 


1 


0 


0 


1 


0.2 


0.2 


100 


C8 


1 


0 


0 


1 


0.7 


0.5 


1000 
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C8 shows the best results for the optimum controller for the slew maneuver. The 
following four figures show the response of the central body and the flexible arm. The 
slew rate is slow, but this is required in order to prevent exciting the first and second 
modes of the arm. 
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Figure 37 Slew Maneuver, C8 
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As a comparison of the PD controller and LQG compensator, an on-orbit mode was 
designed to maintain 0.05 degree pointing accuracy of the central body. For the PD 
controller, the gains, K and t were computed using the equations found on page 139 of 
Ref. 5, and assuming that the model could be treated as rigid. The inertia of the system 
about the Z axis, (fixed), was used in the calculations. The required gains are: K = 
179.3, T = 84.3. For the LQG compensator, was the same as used for Cl, but R„u 
was set at lO"* in order to maintain 0.05 degree accuracy. R„„ was arrived at by trial and 
error. The results are presented in Figure 40 through Figure 43. Both controllers 
control well in the on-orbit mode with only a millimeter movement in the endpoint. 
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Figure 40 On-Orbit Mode, PD Control 




Figure 41 On-Orbit Mode, LQG Compensator 
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Figure 42 On-Orbit Mode, PD Control 




TIUE^ec 

k^Onlludo of Tip Dofloctlon 



Figure 43 On-Orbit Mode, LQG Compensator 
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V. CONCLUSIONS 



The Flexible Spacecraft Simulator, (FSS), is fully assembled and should become 
operational within the next few weeks. The initial operational configuration has sensors 
and an actuator on the central body. A picture of the present setup is provided in 
Appendix A. With this Phase I setup, actual experiments into the effect of flexible 
spacecraft structures on attitude dynamics and control can be carried out. 

Both the PD control and the LQG compensator show that on-orbit control of the 
central body is readily achievable. Control of the antenna endpoint is not as good, with 
the maximum deflection reaching about one mm for a one N-m impulse disturbance. 
Slewing the central body at a fairly high rate of speed is possible, but at the expense of 
severe oscillations of the arm, and at some point, damage to the arm itself. The 
oscillations imposed by the rapid slew do not damp out quickly, but the torque imposed 
on the central body is small enough that the actuator can still maintain the position of the 
body. Results show that the LQG compensator is better for slewing the arm, but in 
order to use this type of control, two compensators will be required. One compensator 
will be set up for the on-orbit mode, and one for slewing the satellite model. 
Satisfactory control can be achieved, but the maximum slew rate will be about one 
deg/sec. 
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A. RECOMMENDATIONS FOR FURTHER STUDY 



Experimental verification of the mode shapes and frequencies as well as the 
damping coefficient should be accomplished as soon as the instrumentation is available. 
Also, further work is required in optimizing the control design for the slew maneuver 
using only the single actuator. Control of the central body is readily achievable using 
both PD and LQG control, but at the expense of moderate to severe oscillations of the 
arm. Attempts to control the arm using the LQG compensator and weighting the time 
rate of change of the first two mode shapes result in minimizing the amplitude of the 
oscillations. However, control of the position of the central body is then lost. Weighting 
both the arm and the central body results in a slow maneuver of about one deg/ sec and 
low amplitude oscillations of the arm. The magnitude of the time rate of change of the 
acceleration, otherwise known as "jerk", and more importantly, the length of time that 
the jerk is applied appear to have the most effect on the amplitude of the oscillations. 
By programming the body rate during the maneuver such that this effect is minimized, 
better control of the arm and a more rapid slew might be achieved. 

The FSS can be easily expanded to using piezoelectric sensors and actuators on the 
flexible arm. In follow on phases, thrusters may be added to the central body, as well 
as liquid tanks. Endpoint sensing will be added and control of the arm’s endpoint 
attempted. Deployment of space structures, such as antennas and solar arrays, can be 
tested. By adding a motor to the elbow and endpoint, space robotics experiments may 
be attempted. The FSS will be an extremely useful research and teaching tool in the 
challenging area of attitude dynamics and control. [Ref. 8] 
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The design of the experimental setup to simulate spacecraft structural/control 
interactions has been challenging. The current design simulates the classical control 
method where sensors and actuators are located on the central body. However, it can 
be easily extended to simulate control configurations where the sensors and actuators are 
distributed throughout the model. It is a versatile testbed for the investigation of 
techniques in dynamics and control of flexible spacecraft. More importantly, it allows 
experimental verification of analytical results prior to implementation on flight spacecraft. 
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APPENDIX A 




Figure 44 Flexible Spacecraft Simulator 
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Figure 45 Key to Inertia Spreadsheet 
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Hem s 


type 


material 


t 


mensions 




mass 


center ^ 


f iu $$ coon 


miles 


Orient. 


\u' 


IZZ 


In' 


Ixx 


lyy' 


lyy 








a, in 


b, in 


c. in 


Ibm 


r, in 


heta, de 


iZ , in 


phi, deg 














1 


cylinder 


aluminum 


15.00 




O.BB 


58.63 


0.00 


0.00 


0.00 


0.00 


6,313 


6,313 


3,302 


3,302 


3,302 


3,302 


2 


cylinder 


aluminum 


0,75 




0.40 


0.07 


11.75 


345.00 


0.20 


0.00 


0.02 


9.39 


0.01 


8.75 


0.01 


0.64 


3 


cylinder 


air pad 


0.75 




0.66 


0 . 1 ? 


11.75 


345.00 


- 0.40 


0.00 


0.03 


16.60 


0.02 


15.48 


0.02 


1.13 


4 


cylinder 


aluminum 


0.75 




0.40 


0.07 


11.75 


105.00 


0.20 


0.00 


0.02 


9.39 


0.01 


0.64 


0.01 


8.75 


5 


cylinder 


air pad 


0.75 




0.66 


0.12 


11.75 


165.00 


- 0.40 


0.00 


0.03 


16.60 


0 81 


1.13 


O.CI 


15.48 


5 


cylinder 


aluminum 


i .75 




0.40 


0.27 


11.75 


225,00 


0,20 


0.00 


0.02 


9.39 


0.09 


B . S 9 


0.09 


0.89 




cylinder 


air pad 


0.75 




0.66 


0.12 


11.75 


225.00 


- 0.40 


0.00 


0.03 


15.60 


0 Cl 


9.96 


0.01 


6.96 


1 8 


doughnut 


aluminum 


3.83 


2.24 


0.25 


0.73 


0.00 


0.09 


0.56 


0.00 


7,16 


7 16 


1.09 


1.09 


1.09 


1.09 


5 


doughnut 


aluminum 


2.64 


2.24 


0.50 


0.29 


0.00 


0 . 0 ] 


0.94 


0.00 


7,16 


7,16 


0 88 


0.88 


0.88 


0.88 


15 


doughnut 


aluminum 


2.64 


2.24 


0.13 


0.07 


D.DO 


0.03 


1.25 


0.00 


0 14 


0 44 


0.23 


0,23 


0.23 


0,23 




cylinder 


steel 


5.15 




1.00 


23.50 


11.27 


165.00 


8.25 


0.00 


311.64 


3,296 


157,78 


2,943 


157.78 


357.72 


12 


cylinder 


motor 


3.83 




6 34 


17.50 


11.27 


165.00 


3 86 


0.00 


119.14 


2,342 


118,19 


2,192 


118.19 


267,08 


13 


cylinder 


air pad 


i .75 




0.66 


0 11 


42.25 


0.09 


- 0.40 


0 00 


0,03 


?14 24 


0 02 


214 23 


0.02 


0.02 


14 


cylinder 


air pad 


0.75 




0.66 


0.12 


49 74 


328.10 


- 0.40 


0.00 


0.03 


296.92 


O.CI 


214,00 


O.DI 


82.93 


15 


plate 


aluminum 


5.00 


2.00 


0,25 


0.27 


12,50 


0.08 


0.56 


0.00 


0.58 


38.08 


0.50 


38.00 


0.08 


0.08 


16 


plate 


aluminum 


1.00 


0.97 


1.13 


0.10 


15.39 


1.90 


o.?o 


0.00 


0,02 


24.83 


0.02 


24.81 


0.02 


0.09 


14 


plate 


aluminum 


1.00 


1.00 


0 25 


0 . 1 ? 


14.51 


30.00 


0.56 


- 98.90 


0.14 


20.35 


L 13 


20.22 


0.01 


) 1.13 


16 


plate 


aluminum 


2 00 


1.50 


0.75 


0.22 


15.75 


91.90 


0.00 


• 91.90 


0 11 


53.69 


0.09 


53,57 


0.09 


0.14 


19 


plate 


aluminum 


3 50 


3,50 


0 25 


0.29 


11 75 


345 00 


0 56 


0.00 


0.60 


41 19 


0.30 


3 02 


0 30 


36, ll 


20 


plate 


aluminum 


3.50 


3.50 


0.25 


0.29 


11.75 


105.00 


0.56 


15.00 


0.60 


41.19 


0.30 


38.17 


0.30 


3.02 


21 


plate 


aluminum 


3.50 


3.50 


0.25 


0.29 


11.75 


225.00 


0.56 


45.00 


0.60 


41.19 


0.30 


20.60 


0.30 


20.60 


22 


plate 


aluminum 


B .71 


B .71 


0.25 


1 . B 2 


B . 7 B 


165.00 


0.56 


15.00 


23.02 


163.38 


11,52 


20.92 


11.52 


142 . 4 B 


23 


plate 


aluminum 


9.74 


13.77 


0 . 3 B 


4.26 


7.93 


165.00 


7.20 


15.00 


100 . 8 B 


368.47 


33.69 


53.87 


67.29 


314.71 


24 


plate 


aluminum 


B .21 


0.25 


6 34 


1.25 


9 70 


190.00 


3.86 


15.00 


7.02 


124 56 


11.20 


14.28 


4 19 


118 66 


25 


plate 


aluminum 


8.29 


0.25 


6.34 


1.25 


9 70 


140 00 


3.86 


15.00 


7.02 


124,56 


11.20 


59 30 


1.13 


73,64 


26 


plate 


aluminum 


1.75 


0,25 


6.34 


0 , 2 ? 


5,80 


130.00 


3.86 


15,00 


0,07 


9.03 


0.89 


e 19 


0.89 


1.89 


21 


plate 


aluminum 


1.75 


0.25 


6,34 


0.27 


5 80 


200.00 


3.86 


15.00 


0.07 


9.03 


0 86 


1.08 


0.88 


8.81 


2 S 


plate 


aluminum 


1.75 


0.25 


6.34 


0.27 


13.25 


118.19 


3 85 


15,00 


0.07 


46.82 


0.96 


0.96 


0.88 


47.64 


29 


plate 


aluminum 


1.75 


0 25 


6 34 


0 27 


13 25 


150 50 


3 86 


15 OOJ 


0,07 


46 82 


0.96 


12 . 2 » 


0 89 


36 31 


30 


special 


aluminum 


3.00 


13.77 


0 . 3 B 


1.49 


14.63 


165.00 


7.20 


15.00 


24.61 


342.92 


1.13 


23.95 


23.52 


319.00 


31 


plate 


aluminum 


2.00 


1.50 


0.75 


0.22 


15.75 


208.10 


0.00 


61.90 


0.11 


53.69 


0.08 


11.94 


0.05 


41.77 


32 


plate 


aluminum 


4.00 


1.00 


0.25 


0.10 


14.51 


210.00 


0.56 


60.00 


0.14 


20.35 


0.13 


5.09 


0.01 


15.26 


33 


plate 


aluminum 


3.00 


1.50 


0.25 


0.11 


8.00 


300.00 


0.56 


60.00 


0.10 


7.01 


0.08 


5.22 


0.02 


1.79 



Figure 46 Inertia of System 



56 




1 xy 


Ixz 


lyz 


cmcalc X 


cmcalc y 


cmcalc z 


xd ist 


yd 1 St 


zd ist 


t|fpe 


1 tern tt 
























0.00 


0.00 


0.00 


0.00 


0.00 


0.00 


0.00 


0.00 


0.00 


cy 1 1 nder 


1 


- 2 . 3 ^ 


0.15 


- 0.04 


0.01 


0.00 


0.00 


11.35 


- 3.04 


0.20 


cy 1 1 nder 


2 


-A U 


- 0.54 


0.15 


0.01 


0.00 


0.00 


11.35 


- 3.04 


- 0.40 


cyl inder 


3 


■2.3A 


- 0.04 


0.15 


0.00 


0.01 


0.00 


- 3.04 


11.35 


0.20 


cy 1 inder 


4 


-A.U 


0.15 


- 0.54 


0.00 


0.03 


0.00 


- 3.04 


11.35 


-0 40 


cy 1 1 nder 


6 


^.68 


- 0.31 


- D .31 


0.00 


c.cc 


0.00 


- 8.31 


- 8.31 


0,20 


cyl 1 nder 


6 


8.28 


0.90 


0.00 


- 0.01 


- 0,01 


0.00 


- 8.31 


- B .31 


-0 40 


cyl 1 nder 


7 


0.00 


0.00 


0.00 


0.00 


O.DC 


0.00 


0.00 


0.00 


0.56 


doughnut 


6 


0,00 


0.00 


0.00 


0.00 


t.ct 


0 oc 


0.00 


0.00 


0.99 


doughnut 


9 


0,00 


0.00 


0.00 


0.00 


c.co 


0.00 


0.00 


0.00 


I . 2 i 


doughnut 


10 


- 746.20 


- 2,111 


565.51 


- 2.00 


0.54 


1.51 


- 19,89 


2.92 


8.25 


cy 1 1 nder 


11 


-555 68 


- 735,35 


197.04 


- 1.49 


C.BO 


0 53 


-10 89 


2 92 


3 86 


cy 1 1 nder 


12 


0.00 


- 2.03 


0,00 


0,09 


0.00 


0.00 


42.25 


0.00 


- 0.40 


cyl 1 nder 


19 


' 133.19 


- 2.03 


1.26 


0.09 


- 0.02 


0.00 


42.23 


- 26.28 


- 0.40 


cyl 1 nder 


19 


3 . 0 ] 


1.68 


0.00 


0.01 


C.CC 


0 00 


12,50 


0.00 


0,56 


plate 


11 


C .82 


0.00 


0,00 


0.01 


o.oa 


0.00 


15.38 


0.51 


0.00 


plate 


10 


0.00 


0.00 


0.78 


0.00 


0.01 


0.00 


0,00 


14 51 


0,56 


plate 


19 


- 1.78 


0.00 


0.00 


0.00 


0.03 


0.00 


- 0.52 


15 , 7 'l 


0.00 


plate 


18 


-10 15 


1.87 


- 0.60 


0.01 


- 0.01 


0.00 


11.35 


- 3.04 


0.56 


plate 


IB 


- 10.15 


- D .54 


1.87 


- 0.01 


0.03 


0.00 


- 3.04 


11.35 


0,56 


plate 


2Q 


20.30 


- 1.37 


- 1.37 


- 0.02 


- 0,02 


0.00 


- 8.31 


- B .31 


0,56 


plate 


24 


- 35.09 


- 6.61 


2.32 


- 0.12 


0.01 


0.01 


- 8.48 


2.27 


0,56 


plate 


24 


- 58.50 


- 234.68 


62.88 


-0 25 


0.07 


0.91 


- 7.66 


2.05 


7 20 


plate 


24 


18.35 


- 46.06 


- 8.12 


- 0.09 


-0 02 


0.01 


- 9.55 


- 1.68 


1 89 


plate 


24 


- 59.63 


- 35.83 


30.07 


- 0.07 


0 CO 


0.01 


- 7.43 


8 29 


1.09 


plate 


24 


■' t.'ia 


- 3.83 


4.57 


- 0.01 


0.01 


0.01 


- 3.73 


4.44 


3.86 


plate 


26 


2.86 


- 1.60 


-2 03 


- 0.01 


O.DO 


0 01 


-5 45 


- 1.98 


3,86 


plate 


27 


- 0.51 


- 13.62 


0.14 


- 0.03 


C.CC 


0.01 


- 13.25 


0. 14 


1.99 


plate 


2 ^ 


- 20,05 


- 11,85 


6.71 


-0 02 


0 09 


0.01 


- 11.53 


6.52 


3,86 


p 1 ate 


24 


• 73.98 


- 151.31 


4 C .54 


- 0.16 


0.09 


c.ce 


- 14.13 


3.79 


1.26 


special 


30 


22.25 


0.00 


D.CC 


- 0.02 


- 0.01 


0,00 


- 13,89 


- 7.42 


0.00 


p 1 ate 


31 


9.10 


- 0.68 


- 0 . 3 i 


- 0.01 


- 0.01 


o.oa 


- 12.57 


- 7.26 


0,56 


plate 


39 


-3 02 


0,24 


-0 42 


0.00 


- 0.01 


o.os 


4.00 


-6 93 


0 56 


plate 


33 



Figure 47 Inertia of System, cont. 



57 



•1 


plate 


sensor 


1 20 


1 .40 


2 25 


0.25 


8.00 


293.10 


5.24 


60.00 


0.07 


16 07 


0.14 


12.36 


0.15 


3.92 


35 


plate 


aluminum 


3,00 


0 13 


4.25 


0,16 


8.05 


293.80 


2.56 


■30.00 


0.11 


10.03 


0.35 


6.62 


0.23 


1.07 


35 


plate 


alumtnum 


1 55 


12 00 


0 13 


0 22 


11.27 


165 00 


9 49 


105 00 


2 72 


31 07 


0 04 


4 40 


2 68 


26 67 


>2 


plate 


aluminum 


26 25 


0 06 


1 00 


0 16 


28 12 


a. 39 


0 00 


O.DO 


9 04 


133 58 


8. 50 


9 06 


0 51 


124 55 


35 


plate 


steel 


2.00 


2.ao 


0.50 


0 EB 


42.25 


0.00 


0 30 


0.00 


0.45 


1.205 37 


0 24 


0 24 


0.21 


1,205,16 


• 2 


plate 


aluminum 


24.25 


0 06 


1.SD 


0.15 


44.21 


342.70 


0.00 


0.00 


7.13 


291.51 


7.14 


32.29 


0.51 


259.25 


• 2 


plate 


steel 


2.00 


2.00 


0.50 


0.61 


49 74 


32B.10 


0 10 


0.00 


0.41 


1,503.40 


0.21 


419.92 


0.21 


1,083.50 


• 1 


doughnut 


aluminum 


5.50 


5.30 


2.00 


1.30 


11.27 


115.00 


8.00 


0.00 


3.96 


169-44 


2.06 


13.14 


2.06 


156.45; 


• 2 


cy 1 inder 


a 1 umi num 


5 63 




0 06 


0 60 


11.27 


165 00 


8 00 


0.00 


9 14 


85 19 


4 72 


75 40 


4 72 


9 79 


a1 


pt mass 


steel 


1 00 


2 40 


1 50 


1 03 


18 25 


0 00 


0 00 


0.00 


0.5B 


343 63 


0.28 


0.28 


0 08 


343 74 


a2 


pt. mass 


steel 


1 00 


2.40 


1,50 


1 03 


20 75 


3.3) 


0 00 


0.00 


0.5B 


444 06 


0.26 


0.20 


0.65 


444 17 


a1 


pt mass 


steel 


100 


2.40 


1.50 


1 03 


23 25 


3.33 


0 00 


0.00 


0.5B 


557.36 


0 28 


0.28 


0.28 


557.47 


a1 


pt mass 


steel 


1 00 


2.40 


1.50 


1 03 


25.75 


3.33 


0 00 


0.00 


0.5B 


603.53 


C.2I 


0.28 


0.69 


603.64 


s2 














28 25 


3.33 


0 00 
















35 














30 75 


0.63 


0 00 
















a1 














33 25 


0 00 


0 00 
















a2 


pt. mass 


steel 


1.00 


2.40 


1 50 


1 03 


35 75 


3.30 


0 00 


0.00 


0.5B 


1,316.98 


0 28 


0.28 


0.28 


1,317.09 


a2 


pt mass 


steel 


1 00 


2.40 


1.50 


1 03 


3B 75 


3.33 


0 00 


0.00 


0.58 


1,507.53 


0 26 


0.28 


3.28 


1,507.64 


alO 


pt mass 


steel 


1 00 


2.10 


1.50 


1 03 


42 25 


3.33 


0 00 


0.00 


0.58 


1,039.19 


0 26 


0.28 


3.28 


1,039.30 
















42 48 


353 60 


0 oo 
















o2 














42 84 


350 30 


0 00 
















o2 














43 33 


347 00 


0 oo 
















bi 














44.02 


343 80 


0 oo 
















o2 














44,72 


345.70 


0.00 
















b6 














45 61 


337 BO 


0 00 
















b7 


pt. mass 


steel 


1.00 


2.40 


1 50 


1.03 


46 61 


334.90 


0.00 


-90.00 


0.5B 


2,238.25 


0.28 


403 34 


0 69 


1,835.29 


be 


pt. mass 


steel 


1 00 


2 40 


1 50 


1.03 


47.72 


332.20 


0.00 


•90.00 


0.5B 


2,346 09 


0.28 


510.88 


0.69 


1,835 61 


b9 


pt mass 


steel 


2.00 


4. BO 


1.50 


2.06 


49.74 


328.10 


0.00 


•90.00 


4.64 


5.101 22 


1 07 


1,427.55 


4.34 


3,674 45 





































Figure 48 Inertia of System, cont. 



-6.79 


5 . 


1 0 


-9.16 


0.01 


-0 01 


0,01 


3 89 


-6 . 


99 


5 . 24 


plate 


34 


- 3 6 1 


1 27 


- 2 88 


0 OS 


-0 01 


0 00 


3 25 


- 7 


37 


2 56 


plate 


42 


- 7 75 


-23 


06 


6 10 


-0 02 


• 0 0 1 


0 oa 


- 1 0 89 


2 


S2 


i 08 


plate 


42 


0 . aa 


0 . 


DO 


0 DD 


0 05 


0 . OO 


0 . 00 


28.12 


0 . 


□ 0 


O DD 


plate 


34 


0 . OO 


e . 


■ e 


0 . DD 


0 . 22 


0 . OO 


0 . 00 


42 . 25 


0 . 


OO 


0 . 10 


plate 


34 


-8Q 74 


0 


DO 


D DD 


0 05 


-0 Cl 


a □□ 


42 2 1 


- 1 3 


15 


D . DD 


plate 


42 


-674 29 


7 


70 


-4 79 


0 2il 


-0 12 


0 00 


42 23 


-26 


28 


0 OO 


plate 


42 


4 1.37 


- 127 


65 


-34,20 


-0.11 


-0 . 03 


0 08 


-10.89 


-2 . 


92 


8 . DO 


doughnu t 


42 


18 94 


-50 


43 


- 15 66 


-0 05 


-0 01 


0 08 


-10.89 


-2 


92 


8 . DO 


c y 1 I Oder 


42 


0 OO 


0 


OO 


0 CD 


0 15 


0 OO 


0 00 


1 0 25 


0 


OO 


0 OO 


pt 


mass 


a 4 


0 00 


0 


OO 


O DD 


0.17 


0 , 00 


0 . 00 


20 . 75 


0 . 


OO 


0 DO 


pt . 


mass 


42 


0.00 


0 . 


00 


O DD 


0 15 


0 . 00 


0 00 


2t 25 


0 . 


00 


0 . DO 


pt 


mass 


a9 


0 00 


□ 


00 


0 OO 


0 21 


0 00 


0 00 


25 75 


0 


OO 


0 OO 


pt 


mass 


a 4 














28 25 


0 


00 


0 OO 




aS 














30 . 75 


0 


00 


0.00 




aS 














33 25 


0 


00 


0 . 00 




42 


0 00 


0 


DO 


0 OO 


3 li 


0 00 


0 00 


35 75 


0 


00 


0 . 00 


pt 


mass 


a4 


0 . 00 


0 


. DO 


0 . 00 


0.31 


0 . 00 


0 . 00 


38 . 25 


0 


00 


O.DO 


pt 


mass 


a9 


□ 00 


0 


OO 


D . DD 


0 .31 


0 . 00 


0 . 00 


42 . 25 


0 


□ 0 


0 , DO 


pt 


mass 


a 1 0 














42 22 


-4 


74 


0 OO 




42 














42 23 


- 7 


22 


0.00 




42 














42 22 


-9 


75 


0 00 




o9 














42 2 1 


- 1 2 


20 


0 00 




o9 














42 21 


- 1 4 


78 


0 00 




b5 














42 . 23 


-17. 


23 


0 . 00 




oS 


- 060 


0 


00 


0 . OO 


0 34 


-0 16 


0 . 00 


42,21 


- 1 9 


77 


0.00 


pt 


mass 


b7 


• 960 


0 


00 


0 . 00 


0 . 34 


-0.18 


0 . 00 


42 21 


-22 . 


26 


0 00 


pt 


ma s s 


b8 


-2206 


0 


. 00 


0 . 00 


0 . 66 


-0.42 


0 . 00 


42 . 23 


-26 . 


20 


0 . 00 


Pt . 


mass 


b9 

























Figure 49 Inertia of System, cont 



58 




|tc 


tl MS). 1 center 


MSS ef : 


vslon 










<r 


ertii of ly 


tWB, Ib-in* 








f 




lbs 


X 


y 


Z 






IZZ 




Ixx 




Ixx 


Ixz 


Ixz 


Ixz 






12B 00 


•1.52 


0 59 


2 66 






33,950 




12,242 




22,149 


-6,466 


-3,547 


840 
























Inertli c 


' lystfM 












kO 


X , cm 


1 4 cm 


z, cm 












kg- 


n*2 
























Izz 




txi 




Ixz 


Ixz 


Ixz 


Ixz 






se.06 


-3 66 


1,51 


6 75 






9 94 




• 59 




6.48 


•1.B9 


-1.09 


0.25 


















Izzol 
































9,94 




















































Po 


billon 


and mass 


of ea< 


h subbody 


























node 


Psx, f 


Psy. m 


pt 


mass, kg 




























































4 


0.42 


-0.01507 


aO 


0,00 
























5 


0 502 


•0.01507 


al 


0 474 
























9 


0.566 


-0,01507 


a2 


0.474 
























9 


0.629 


•0,01507 


87 


0.474 
























1C 


0.693 


-0 01507 


8? 


0 474 
























11 


0 756 


-0.01507 


aj 


0.007 
























ii 


0.92 


-0.01507 


a9 


0 007 
























14 


0.633 


-0.01507 


87 


0 007 
























14 


0.947 


0,01507 


a9 


0.474 
























3 


1.01 


•0.01507 


a9 


0.474 
























4 


1.112 


•0,01507 


alO 


0.833 
























9 


1.111 


-0. 13534 


o7 


0.007 
























1i 


1.111 


•0 19841 


o2 


0.007 
























16 


1.111 


-0.26264 


a9 


0.007 
























11 


1.112 


•0.32701 


o7 


0.033 
























18 


1.111 


0 39049 


b5 


0 007 
























19 


1.111 


-0.45279 


b6 


0.007 
























20 


1.111 


-0.51727 


b7 


0.474 
























6 


1.111 


■0.58037 


bB 


0.474 
























7 


1.111 


-0.69269 


b9 


1.269 























Figure 50 Inertia of System, cont 



59 



APPENDIX B 



A. ROTARY VARIABLE DIFFERENTIAL TRANSFORMER 

1. Manufacturer - Schaevitz Engineering 

2. Model - R30D 

3. Scale Factor - 0.126 VDC/degree 

4. Linearity - 0.16% 



B. ANGULAR RATE SENSOR 

1. Manufacturer - Watson Industries, Inc 

2. Model - ARS-C121-1A 

3. Sensitivity - 30 deg/sec full scale 

4. Frequency Response - DC to 50 Hz 



C. ACCELEROMETER 

1. Manufacturer - PCB Piezotronics, Inc 

2. Model - 302A02 

3. Resolution - 0.01 g 

4. Frequency Range (+ 5%) - 0.05 to 5000 Hz 
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D. DC SERVO MOTOR 



1. Manufacturer - PMI Motion Technologies 

2. Model - JR16M4CH/F9T 

3. Horsepower - 1.4 HP 

4. Peak Torque - 5307.2 oz-in 

5. Peak Acceleration without Load - 63.2 KRAD/SEC^ 

6. Cogging Torque - 0 

7. Terminal Voltage - 128.7 VDC 

8. Current - 9.55 amp 

9. Power Output - 1049.5 Watts 

10. Torque Constant - 52.77 oz-in/amp 

11. Mechanical Time Constant, no load - 3.15 msec 

12. Electrical Time Constant - < 0.14 msec 

13. Speed Regulation - 0.36 RPM/oz-in 

14. Motor Diameter - 7.38 in 

15. Motor Length - 4.50 in 

16. Motor Weight - 17.50 lb 
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APPENDIX C 



A. GIFTS OUTPUT 



)B: arm5 
MODE 


FREQ 


9-MAY-91 

FREQUENCIES 

EIGV 


1 


1,21602E-01 


5,83767D-01 


2 


3,46436E-01 


4,738120+00 


3 


2.65877E+00 


2.79075D+02 


4 


3.55180E+00 


4.98031D+02 


5 


6.12919E+00 


1.48308D+03 


6 


1.66874E+01 


1,099350+04 



PAGE 1 



JOB:arm5 9- 


-MAY-91 MODE 1 ~ 1,216E-01 CPS 15;39;19 

DISPLACEMENT INFORMATION 
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0,000E+00 


2 


l,390E-08 


l,917E-03 


l,114E-36 


0,000E+00 
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0,000E+00 


0,000E+00 
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O.OOOE+00 


0,000E+00 
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0,000E+00 


0,000E+00 
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0,000E+00 


0,000E+00 
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0,000E+00 


0,000E+00 
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4,733E-36 


0,000E+00 
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0,000E+00 


3,307E-01 


11 


8,339E-08 


6,465E-02 


8,218E-36 
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0,000E+00 


4,791E-01 
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l,18lE-07 


1,254E-01 


l,165E-35 


0,000E+00 


0,000E+00 


5,468E-01 
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l,355E-07 


1,622E-01 


l,337E-35 


0,000E+00 


0,000E+00 


6,101E-01 
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2,85lE-35 


0,000E+00 


0,000E+00 
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9,706E-01 


19 


3,923E-01 


2,801E-01 
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JOB:arm5 9* 


-MAY-91 MODE 2 — 3.464E-01 CPS 15:39:19 

DISPLACEMENT INFORMATION 
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-2,597E-01 


5 


-3,969E-03 


-4,343E-01 


-7.490E-27 


0,000E+00 


0,000E+00 


1,782E-01 


6 


3,009E-01 


-4,343E-01 


-9,80lE-27 


0,000E+00 


0,000E+00 


9.829E-01 


7 


4,022E-01 


-4,343E-01 


-l,045E-26 


0,000E+00 


0,000E+00 


l,005E+00 


8 


l,549E-07 


-3,043E-02 


-8,062E-28 


0,000E+00 


0,000E+00 


-4,996E-01 


9 


2,409E-07 


-6,859E-02 


-1.301E-27 


0,000E+00 


0,000E+00 


-6,922E-01 


10 


3,269E-07 


-1,171E-01 


-1.786E-27 


0,000E+00 


0,000E+00 


-8,251E-01 


11 


4.130E-07 


-1,721E-01 


-2.258E-27 


0,000E+00 


0,000E+00 


-8,996E-01 


12 


4,990E-07 


-2,301E-01 


-2.730E-27 


O.OOOE+00 


0,000E+00 


-9,168E-01 


13 


5,85lE-07 


-2,874E-01 


-3,202E-27 


0,000E+00 


0,000E+00 


-8,767E-01 


14 


6,711E-07 


-3,402E-01 


-3,674E-27 


0,000E+00 


0,000E+00 


-7,794E-01 
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15 


1.360E-02 


-4.343E-01 -7.833E-27 


O.OOOE+OO 


O.OOOE+OO 


3.709E-01 


16 


4-258E-02 


-4-343E-01 -8.174E-27 


O.OOOE+00 


O.OOOE+OO 


5.376E-01 


17 


8.132E-02 


-4.343E-01 -8.515E-27 


O.OOOE+OO 


O.OOOE+OO 


6.782E-01 


18 


1.282E-01 


-4.343E-01 -8.854E-27 


O.OOOE+OO 


O.OOOE+OO 


7.928E-01 


19 


1-815E-01 


-4,343E-01 -9.193E-27 


O.OOOE+OO 


O.OOOE+OO 


8,815E-01 


20 


2-396E-01 


-4.343E-01 -9-531E-27 


O.OOOE+OO 


O.OOOE+OO 


9.442E-01 


JOB:arm5 9- 


-MAY-91 MODE 3 — 2.659E+00 CPS 15:39:19 

DISPLACEMENT INFORMATION 


PAGE 


POINT 


U 


V w 


RX 


RY 


RZ 


1 


O.OOOE+00 


0 • OOOE+00 0 • OOOE+00 


O.OOOE+OO 


O.OOOE+OO 


O.OOOE+OO 


2 


-4.969E-07 


5.494E-02 -4.018E-18 


O.OOOE+OO 


O.OOOE+OO 


2.014E+00 


3 


-5.466E-06 


3.727E-01 -5.372E-17 


O.OOOE+OO 


O.OOOE+OO 


-4.275E+00 


4 


-6.521E-06 


-1.385E-01 -7.411E-17 


O.OOOE+OO 


O.OOOE+OO 


-4.782E+00 


5 


-5,142E-01 


-1.385E-01 -9,646E-17 


O.OOOE+OO 


O.OOOE+OO 


-3.628E+00 


6 


-3-166E-01 


-1.385E-01 -1.255E-16 


O.OOOE+OO 


O.OOOE+OO 


5.428E+00 


7 


3.009E-01 


-1.385E-01 -1.336E-16 


O.OOOE+OO 


O.OOOE+OO 


6.403E+00 


8 


-1.118E-06 


2.309E-01 -1.058E-17 


O.OOOE+OO 


O.OOOE+OO 


3.306E+00 


9 


-1.739E-06 


4.487E-01 -1.705E-17 


O.OOOE+OO 


O.OOOE+OO 


3.367E+00 


10 


-2.360E-06 


6.392E-01 -2.339E-17 


O.OOOE+OO 


O.OOOE+OO 


2.517E+00 


11 


-2.981E-06 


7.599E-01 -2.954E-17 


O.OOOE+OO 


O.OOOE+OO 


1.267E+00 


12 


-3.602E-06 


7.982E-01 -3.568E-17 


O.OOOE+OO 


O.OOOE+OO 


-7.512E-02 


13 


-4.223E-06 


7,486E-01 -4-183E-17 


O.OOOE+OO 


O.OOOE+OO 


-1.500E+00 


14 


-4,845E-06 


6,062E-01 -4.796E-17 


O.OOOE+OO 


O.OOOE+OO 


-2.997E+00 


15 


-7.177E-01 


-1,385E-01 -1.008E-16 


O.OOOE+OO 


O.OOOE+OO 


-2.753E+00 


16 


-8,601E-01 


-1,385E-01 -1.050E-16 


O.OOOE+OO 


O.OOOE+OO 


-1.705E+00 


17 


-9.308E-01 


-1,385E-01 -1,093E-16 


O.OOOE+OO 


O.OOOE+OO 


-4.958E-01 


18 


-9.199E-01 


-1.385E-01 -1.136E-16 


O.OOOE+OO 


O.OOOE+OO 


8.632E-01 


19 


-8.183E-01 


-1.385E-01 -1.178E-16 


O.OOOE+OO 


O.OOOE+OO 


2.359E+00 


20 


-6.177E-01 


-1.385E-01 -1.221E-16 


O.OOOE+OO 


O.OOOE+OO 


3.979E+00 


JOB:arm5 9- 


-MAY-91 MODE 4 — 3.552E+00 CPS 15:39:20 

DISPLACEMENT INFORMATION 


PAGE 


POINT 


U 


V w 


RX 


RY 


RZ 


1 


O.OOOE+00 


0 . OOOE+00 0 • OOOE+00 


O.OOOE+OO 


O.OOOE+OO 


O-OOOE+00 


2 


-1.978E-06 


-6.461E-02 -7.421E-13 


O.OOOE+OO 


O.OOOE+OO 


-2.330E+00 


3 


-2.176E-05 


-9.639E-02 -9-922E-12 


O.OOOE+OO 


O.OOOE+OO 


2.818E+00 


4 


-2.596E-05 


9,628E-02 -1,369E-11 


O.OOOE+OO 


O.OOOE+OO 


2.391E-01 


5 


-1.943E-01 


9.628E-02 -1,782E-11 


O.OOOE+OO 


O.OOOE+OO 


-3.010E+00 


6 


-4.788E-01 


9.630E-02 -2.318E-11 


O.OOOE+OO 


O.OOOE+OO 


6-757E+00 


7 


3-414E-01 


9.630E-02 -2.468E-11 


O.OOOE+OO 


O.OOOE+OO 


8.730E+00 


8 


-4.450E-06 


-2,597E-01 -1.954E-12 


O.OOOE+OO 


O.OOOE+OO 


-3.498E+00 


9 


-6.922E-06 


-4.736E-01 -3,150E-12 


O.OOOE+OO 


O.OOOE+OO 


-2.995E+00 


10 


-9.395E-06 


-6,177E-01 -4-320E-12 


O.OOOE+OO 


O.OOOE+OO 


-1.436E+00 


11 


-1.187E-05 


-6,529E-01 -5.456E-12 


O.OOOE+OO 


O.OOOE+OO 


2.636E-01 


12 


-1.434E-05 


-5,924E-01 -6.591E-12 


O.OOOE+OO 


O.OOOE+OO 


1.576E+00 


13 


-1.681E-05 


-4,612E-01 -7.725E-12 


O.OOOE+OO 


O.OOOE+OO 


2.487E+00 


14 


-1.928E-05 


-2,853E-01 -8.859E-12 


O.OOOE+OO 


O.OOOE+OO 


2.983E+00 


15 


-4.093E-01 


9.629E-02 -1.862E-11 


O.OOOE+OO 


O.OOOE+OO 


-3.639E+00 


16 


-6.409E-01 


9.629E-02 -1.941E-11 


O.OOOE+OO 


O.OOOE+OO 


-3.532E+00 


17 


-8.426E-01 


9.629E-02 -2.020E-11 


O.OOOE+OO 


O.OOOE+OO 


-2.702E+00 


18 


-9.691E-01 


9,629E-02 -2.099E-11 


O.OOOE+OO 


O.OOOE+OO 


-1.167E+00 


19 


-9.764E-01 


9.630E-02 -2-177E-11 


O.OOOE+OO 


O.OOOE+OO 


1.050E+00 


20 


-8,219E-01 


9.630E-02 -2.256E-11 


O.OOOE+OO 


O.OOOE+OO 


3-925E+00 



J0B:arm5 9- 

POINT U 

1 O.OOOE+00 

2 -1.587E-06 



MAY-91 MODE 5 — 6.129E+00 CPS 
DISPLACEMENT INFORMATION 
V W RX 

©•OOOE+OO 0,000E+00 O.OOOE+00 
1,130E-01 3,628E-16 0,000E+00 



15:39:20 



RY 

0,000E+00 

O.OOOE-fOO 



PAGE 1 



RZ 

O.OOOE+00 

3.885E+00 
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3 


-1-746E-05 


-6.445E-01 


4.931E-15 


O.OOOE+00 


O.OOOE+00 


5.642E+00 


4 


-2.083E-05 


1.459E-01 


6.886E-15 


O.OOOE+00 


O.OOOE+00 


6.691E+00 


5 


4.542E-01 


1.459E-01 


9.133E-15 


O.OOOE+00 


O.OOOE+00 


1.199E+00 


6 


-1.567E-01 


1.460E-01 


1.205E-14 


O.OOOE+00 


O.OOOE+00 


1.417E+00 


7 


7.650E-02 


1.460E-01 


1-288E-14 


O.OOOE+00 


O.OOOE+00 


2.733E+00 


8 


-3.571E-06 


3.975E-01 


9.561E-16 


O.OOOE+00 


O.OOOE+00 


4.293E+00 


9 


-5.555E-06 


5.800E-01 


1.544E-15 


O.OOOE+00 


O.OOOE+00 


1.004E+00 


10 


-7,539E-06 


4.984E-01 


2.123E-15 


O.OOOE+00 


O.OOOE+00 


-3.540E+00 


11 


-9.523E-06 


1.609E-01 


2.690E-15 


O.OOOE+00 


O.OOOE+00 


-6.641E+00 


12 


-1-151E-05 


-2.880E-01 


3.257E-15 


O.OOOE+00 


O.OOOE+00 


-7-049E+00 


13 


-1.349E-05 


-6,774E-01 


3.824E-15 


O.OOOE+OO 


O.OOOE+00 


-4,767E+00 


14 


-l,547E-05 


-8.373E-01 


4.390E-15 


O.OOOE+00 


O.OOOE+00 


1.696E-01 


15 


4,635E-01 


1.459E-01 


9.565E-15 


O.OOOE+00 


O.OOOE+00 


-7.967E-01 


16 


3,670E-01 


1.460E-01 


9.996E-15 


O.OOOE+00 


O.OOOE+00 


-2-128E+00 


17 


2.080E-01 


1.460E-01 


1.043E-14 


O.OOOE+OO 


O.OOOE+00 


-2.764E+00 


18 


3.123E-02 


1.460E-01 


1.086E-14 


O.OOOE+00 


O.OOOE+00 


-2.683E+00 


19 


-1.174E-01 


1.460E-01 


1.128E-14 


O.OOOE+00 


O.OOOE+00 


-1.877E+00 


20 


-1.919E-01 


1.460E-01 


1.171E-14 


O.OOOE+00 


O.OOOE+00 


-3.489E-01 


JOB:arm5 9- 


-MAy-91 MODE 6 — 1.669E+01 CPS 15:39:20 

DISPLACEMENT INFORMATION 


1 PAGE 


POINT 


U 


V 


W 


RX 


RY 


RZ 


1 


O.OOOE+00 


O.OOOE+00 


O.OOOE+00 


O.OOOE+00 


O.OOOE+00 


O.OOOE+00 


2 


~2,502E-06 


4.201E-01 


-1.665E-10 


O.OOOE+00 


O.OOOE+00 


1.237E+01 


3 


-2.750E-05 


3.589E-01 


-2-232E-09 


O.OOOE+00 


O.OOOE+00 


2.310E+00 


4 


-3.280E-05 


-2.598E-02 


-3.084E-09 


O.OOOE+00 


O.OOOE+00 


-6.379E+00 


5 


-6.684E-01 


-2.601E-02 


-4,025E-09 


O.OOOE+00 


O.OOOE+00 


-4.134E+00 


6 


1.220E-01 


-2.611E-02 


-5.246E-09 


O.OOOE+00 


O.OOOE+00 


6.290E-01 


7 


-2,433E-02 


-2.613E-02 


-5.587E-09 


O.OOOE+00 


O.OOOE+00 


-2.474E+00 


8 


-5.630E-06 


9.551E-01 


-4,385E-10 


O.OOOE+00 


O.OOOE+00 


5.754E-01 


9 


-8.757E-06 


3.730E-01 


-7.071E-10 


O.OOOE+00 


O.OOOE+00 


-1.690E+01 


10 


-1-188E-05 


-7.914E-01 


-9.703E-10 


O.OOOE+00 


O.OOOE+00 


-1.545E+01 


11 


-1.501E-05 


-1.353E+00 


-1.226E-09 


O.OOOE+00 


O.OOOE+00 


-2.824E+00 


12 


-1.813E-05 


-1-231E+00 


-1.481E-09 


O.OOOE+00 


O.OOOE+00 


5.951E+00 


13 


-2.126E-05 


-6.937E-01 


-1.737E-09 


O.OOOE+00 


O.OOOE+00 


1.017E+01 


14 


-2.438E-05 


-4.728E-02 


-l;992E-09 


O.OOOE+00 


O.OOOE+00 


9.311E+00 


15 


-8.606E-01 


-2.603E-02 


-4.206E-09 


O.OOOE+00 


O.OOOE+00 


-1.850E+00 


16 


-8.995E-01 


-2.604E-02 


-4,387E-09 


O.OOOE+00 


O.OOOE+00 


6.154E-01 


17 


-7.887E-01 


-2.606E-02 


-4.566E-09 


O.OOOE+00 


O.OOOE+00 


2.786E+00 


18 


-5.617E-01 


-2.607E-02 


-4.746E-09 


O.OOOE+00 


O.OOOE+00 


4.202E+00 


19 


-2.786E-01 


-2.609E-02 


-4.925E-09 


O.OOOE+00 


O.OOOE+00 


4.500E+00 


20 


-1.872E-02 


-2.610E-02 


-5.103E-09 


O.OOOE+00 


O.OOOE+00 


3,449E+00 



B. FORTRAN PROGRAM FORM 



PROGRAM FORM 
AUTHOR: R. J. WATKINS 
DATE: MAY 18, 1991 

THIS PROGRAM READS IN DATA GIVEN BY GIFTS OUTPUT AND 
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PUTS IT INTO A FORMAT FOR STATE-SPACE MODELING 

DOUBLE PRECISION A(16,I6), B(I6), AI, BI 

REAL OMEGA(6),U(6,20),V(6,20),PSX(20),PSY(20),MS(20),IZZ01 

1,DS(6), ES(6), FS(6), GS(6), IW, IZZ02,HS(6),JS(6) 

OPEN (UNIT=10, FILE=’RESXDAT.LPT’, STATUS = ’OLD’) 

OPEN (UNIT=1I, FILE=’PS.DAT’,STATUS = ’OLD’) 

OPEN (UNIT=I2, FILE=’MS.DAT’,STATUS = ’OLD’) 

OPEN (UNIT=I3, FILE= ’CHECK.DAT’, status= ’new’) 

OPEN (UNIT=I4, FILE=’ADMP’,status=’new’,CARRIAGECONTROL=’LIST’) 
OPEN (UNIT=I5, FILE=’BDMP’,status=’new’,CARRIAGECONTROL=’LIST’) 

READ IN OUTPUT FROM PR OUT BATCH FILE 



READ(10,5) 

5 FORMAT {III) 

DO 6 1=1,6 

READ(I0,7) OMEGA(I) 

6 CONTINUE 

7 FORMAT (lOX, El 1.5) 

DO 12 1 = 1,6 

READ(10,5) 

DO 15 J=l,20 

READ(10,13) U(I,J), Va,J) 

15 CONTINUE 

12 CONTINUE 

13 FORMAT(7X,E10.3,1X,E10.3) 

C 

C READ IN MS AND PS DATA FILES 
C PS IS POSITION OF EACH NODE (SUBBODY) IN METERS 
C AND MS IS THE MASS OF EACH SUBBODY IN KG. NOTE 1: FIRST 
C ENTRY IN MS. DAT IS THE INERTIA TERM FOR THE SYSTEM (IZZOl) 
C NOTE 2; MASS AND POSITION OF EACH NODE MUST BE IN SAME 
C SEQUENCE AS OUTPUT IN PR_OUT FILE!! 

C 

DO 201 = 1,20 

READ (11,*) PSXa), PSY(I) 

20 CONTINUE 

READ (12,*) IZZOl 
DO 30 1 = 1,20 

READ (12,*) MS(I) 

30 CONTINUE 
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C FORM THE TERMS FOR THE A AND B MATRIX. ALSO CALCULATE 
C CHECK MATRIX ES; ALL ENTRIES SHOULD BE APPROX 1 IF 
C DATA INPUT CORRECTLY. OUTPUT IS IN CHECK.DAT (ASCII) 

C INPUT DAMPING FOR ARM (ZETA) NOTE: COULD BE CHANGED 
C TO VECTOR IF NECESSARY 
C 

ZETA =0.02 
IZZ02=IZZ01 
DO 35 1 = 1,6 
DS(I)=0.0 
ES(I)=0.0 
DO 32 J = l,20 

DS(I)=DS(I)+(V(I,J)*PSX(J)-U(I,J)*PSY(J))*MS(J) 

ES(I) =ES(I) +(U(I,J)*="2+ V(I,J)**2)*MS(J) 

32 CONTINUE 

WRITE(13,*) ES(I) 

IZZ02 =IZZ02-DS(I)**2 
35 CONTINUE 
DO 38 1 = 1,6 

FS(I) =DS(I)*OMEGA(I)**2 
GS(I)=(0MEGA(I)**2)*IZZ02+DS(I)*FS(I) 

HS(I) =2.0*OMEGA(I)*ZETA*DS(I) 
JS(I)=2.0*ZETA*OMEGA(I)*IZZO2+DS(I)*HS(I) 

38 CONTINUE 

FORM A AND B MATRIX 

DO 45 1 = 1,14 
DO 42 J = l,14 
A(1,J)=0.0 
42 CONTINUE 
45 CONTINUE 
DO 501 = 1,7 
A(I,I+7) = 1.0 
50 CONTINUE 
DO 57 1=2,7 

A(8,I)=FSa-l)/IZZ02 
57 CONTINUE 
DO 65 1=9,14 
DO 60 J =2,7 

A(I,J)=-DSa-8)*FS(J-l)/IZZ02 
60 CONTINUE 
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DO 63 J=9,14 

Aa,J) =-DS(I-8)*HS(J-8)/IZZ02 
63 CONTINUE 

A(I,I)=-JSa-8)/IZZ02 
A(8,I)=HS(I-8)/IZZ02 
A(I,I-7)=-GS(I-8)/IZZ02 
65 CONTINUE 

FORM CONTROL INPUT MATRIX B 

DO 701=1,7 
B(I)=0.0 
70 CONTINUE 
B(8) = 1.0/IZZO2 
DO 75 1=9,14 

B(I)=-DS(I-8)/IZZ02 
75 CONTINUE 

WRITE MATRIX TO FILES. USE MATRIXX SUBROUTINE MATS A V TO 
CONVERT DATA INTO READABLE FORM FOR MATRIXX. OUTPUT 
IS IN ADMP AND BDMP. 



CALL MATSAV(14,’ ASYS’, 16, 14, 14,0,A, AI,’(1P2E24. 15)’) 
CALL MATSAV(15,’BSYS’, 16, 14, 1 ,0,B,BI,’(1P2E24. 15)’) 

END OF PROGRAM 

STOP 

END 
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The following table is reprinted for convenience; 



TABLE rv Weighting Factors 





Rxx 


Ruu 


Designation 


1 


qi 


q2 


•if 


qi 


q2 


T 


C4 


1 


0 


0 


0 


0 


0 


.001 


C2 


1 


10 


10 


0 


0 


0 


0.1 


C3 


1 


10* 


10' 


0 


0 


0 


0.1 


C4 


1 


0 


0 


0 


• 


• 


0.1 


C5 


1 


0 


0 


0 


10' 


10' 


0.1 


C6 


1 


0 


0 


1 


0 


0 


0.1 


C7 


1 


0 


0 


1 


0.2 


0.2 


100 


C8 


1 


0 


0 


1 


0.7 


0.5 


1000 
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Figure 51 Impulse Response, PD2 




Figure 52 Impulse Response, PD3 
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Figure 53 Impulse Response, Cl 




Figure 54 Bias Maneuver, Cl 
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Figure 56 Slew Maneuver, C2 
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Figure 58 Slew Maneuver, C3 
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Figure 60 Slew Maneuver, C4 
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Figure 62 Slew Maneuver, C5 
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Figure 64 Slew Maneuver, C6 
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Figure 66 Slew Maneuver, C7 
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